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(54) TRAINING ROBOT, TRAINING ROBOT SYSTEMAND TRAINING ROBOT CONTROL 
METHOD 

(57)Abstract: 

PROBLEMTO BE SOLVED: To secure safety by imparting 
flexibility of restriction to a motional trajectory and time, 
and perform a smooth action for reducing an unpleasant 
feeling and a burden. 

SOLUTION: This training robot 10 takes three- dimensional 

action of the body by a person on the basis of training and 1 ^: # 

skill in a robot controller 22 including a computer for 
controlling a robot arm 12 as teaching data, and presents 
the motion again to a patient or a user 16 or a trainee 
directly or via a network 52 to perform a training action on 
the limbs, for example, the upper limbs of the person 
supported by the robot arm. 
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damages caused by the use of this translation. 

l.This document has been translated by computer. So the translation may not reflect the original 
precisely. 

Z**** shows the word which can not be translated. 
3.1n the drawings, any words are not translated. 



CLAIIVB 



[Claim(s)] 

[Claim l]Into a driving means which drives a robot arm, and a three- dimensional operation orbit 
determined based on movement based on operation and an act of the body by people. A training 
robot having a movement reproduction control means which controls said driving means so that a 
motion of people's limbs supported by said robot arm reproduces said three- dimensional operation 
orbit based on movement data produced by associating speed and time. 

[Claim 2] The training robot according to claim 1 including a restriction means which controls said 
robot arm so that said movement reproduction control means performs a flexible restraint for 
people's limbs supported by said robot arm to said three- dimensional operation orbit. 
[Claim 3] The training robot according to claim 2 with which said restriction means contains a 
means to generate traction or a resistance force in a tangential direction in accordance with said 
three- dimensional operation orbit. 

[Claim 4] The training robot according to any one of claims 1 to 3 which has further a displaying 
means which displays an orbit of said robot arm of operation [Claim 51The training robot according 
to any one of claims 1 to 4 which has further a data storage means by which said movement data 
was saved. 

[Claim 6] The training robot according to claim 5 which has further a teaching data acquisition 
means which acquires movement based on operation and an act of the body by people as teaching 
data. 

[Claim 7] A computer which creates training and three- dimensional operation of the body by a 
person based on skill as movement data, and saves them, A training robot system including a 
training robot which reproduces movement data received via a means of communication which 
distributes said movement data to a user, and said means of communication from said computer in 
three- dimensional operation of people, and shows a user. 

[Claim 8] The training robot system according to claim 7 with which said traming robot contains a 
ROBO@TTO controller and a robot arm. 

[Claim 9]It is the control method of a training robot which controls a robot arm to reproduce a 
three- dimensional operation orbit determined based on movement based on operation and an act 
of the body by people, A training robot's control method which controls said robot arm based on 
movement data produced by relating speed and time with said three- dimensional operation orbit to 
perform a flexible restraint for people's limbs supported by said robot arm to said three- 
dimensional operation orbit. 



[Translation done.] 
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DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Industrial Application] Especially this invention relates to the training robot which can reproduce 
three- dimensional operation of the body by people, and can show people, the training robot system 
which shows a user this three- dimensional movement through a network, and a traming robot's 
control method about a training robot. 
[0002] 

[Description of the Prior Art]For example, in accordance with the orbit of operation which taught 
operation of the routine work in a factory on- line or off- line, and was registered, the robot itself 
moves to a robot arm correctly, and the efficiency of assembling work, such as parts, etc. is 
increased. 

[0003] However, it is not a thing in consideration of the conventional orbital instruction and 
generation / movement algorithm recording the three- dimensional movement of the body by 
people itself for a robot's own movement (registration), and reproducing operation of people and an 
act. 

[0004] By the way, a robot has a teaching playback system as a method of teaching operation. This 
method is a technique with which a trainer etc. drive a robot arm by hand, and teach operation so 
that the position and posture of a request of a robot may actually be taken. 
[00051 There is also a programming method which programs and teaches operation of a robot using 
a robot programming language. This programming method contains the CRT display as a display 
further with a computer, and the keyboard as an input device and mouse which were connected to 
this computer. 

[0006] And a computer generates an operation program by analyzing the operation model inputted 
by the input device and expressing the contents with a predetermined robot programming 
language, and. Sending the operation program under generation to a robot controller, a robot 
controller operates a robot based on the operation program completed by the input of teaching 
data. 
[0007] 

[Problem(s) to be Solved by the Invention] Although it is dramatically useful to, record and save 
model operation and training operation as a three- dimensional positional attitude, speed, and 
temporal data on the other hand in movement of persons, such as training (training), rehabilitation 
training, and assistance of operation, and the act of a sport, art like calligraphy, etc., and to 
reproduce the movement and act to people, It was difficult to apply to people from fields, such as 
safety and operativity, by an old robot. 

[0008] So, the main puipose of this invention records three- dimensional movement of operation of 
people, an act, etc.. It is providing the training robot system which showed many users the training 
robot which can present three- dimensional movement of operation, an act, etc. recorded to 
oeople, and this three- dimensional movement through the network 
:0009] 

[IVfeans for Solving the Problem] This invention into a three- dimensional operation orbit deteraiiiied 
based on movement based on operation and an act of the body by a driving means and those who 
drive a robot arm. He is a training robot having a movement reproduction control means which 
controls a driving means so that a motion of people's limbs supported by robot arm reproduces a 
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three- dimensional operation orbit based on movement data produced by associating speed and 
time. 

[0010] A computer which other inventions create three- dimensional operation of the body by a 
person based on training, skill, etc. as movement data, and is saved. It is a training robot system 
including a means of communication which distributes movement data to a user from this 
computer, and a training robot which reproduces movement data received via this means of 
communication in three- dimensional operation of people, and shows a user. 
[0011] Other inventions are the control methods of a training robot which controls a robot arm to 
reproduce a three- dimensional operation orbit determined based on movement based on operation 
and an act of the body by people, It is a training robot's control method which controls a robot arm 
based on movement data produced by relating speed and time with this three- dimensional 
operation orbit to perforai a flexible restraint for people's limbs supported by robot arm to a three- 
dimensional operation orbit. 
[0012] 

[Function]In the case of movement reproduction, as opposed to the created orbit of operation, it 
does not restrain by high rigidity like a robot arm, but by applying a virtual dynamic variable spring 
and damper control to the position gap from an orbit, suitable peraiission is accepted and smooth 
movement reappearance is realized. It is possible to always give the power to an orbital tangential 
direction in reproduction of this standard movement, and the movement assistance which gives 
traction, or the movement resistance which gives a resistance force can be dynamically changed 
according to an operating state. Many users can receive training operation of three- dimensional 
movement simultaneously through a network. 
[0013] 

[Effect of the Invention] According to this invention, three-dimensional movement of operation of 
people, an act, etc. is acquired as data, using a robot arm for example as a training robot, At the 
time of the movement reproduction to people, since the restraint over the orbit of standard 
movement and time has strange, dynamically good pliability, it is safe, and little smooth movement 
of the burden to displeasure or the body is attained. 

[0014]The above-mentioned purpose of this invention, the other purposes, the feature, and an 
advantage will become still clearer by detailed explanation of working example given to below with 
reference to Drawings. 
[00151 

[Example] Draw ing 1 i s a perspective view for explaining the outline composition of the training 
robot which shows one working example of this invention. 

[0016] For example, in general training of the rehabilitation of an upper extremity, etc. of operation, 
when a medical practitioner, a physical therapist, etc. do various kinds of movements with a 
patient's hand etc., usually train, but. By applying this invention, upper extremity training using a 
robot arm and training assistance are attained, for example. 

[0017]That is, the therapist equips with a robot arm first the arm which is a part of body as 
training equipment himself as a record method of training operation, for example, rehabilitation 
operation is performed in a teaching mode, and the three- dimensional operation is sampled. And 
the sampled operation is saved in the memoiy of a computer, when a patient performs training 
operation, it reads from a memory, and operation is reproduced. 

[0018] As other methods, after the patient (a user and a trainer are included) has equipped a part 
of body with training equipment, the therapist attaches a hand and performs rehabilitation 
operation in a teaching mode, for example, and the three- dimensional operation is sampled. And 
the sampled model operation (standard operation) is saved in the memory of a computer, when a 
oatient performs training operation anew, it reads from a memory, and operation is reproduced. 
001 9] The operation according to a case is beforehand read into the memory of a computer from 
presewation or the exterior as the other methods, and operation is henceforth reproduced as 
explained previously. 

[0020] The person who applied correspondingly the tip part 14 of the robot arm 12 in which this 
training robot 10 has 3 flexibility to utilization time in drawin^ L (For example, user including a 
patient and a trainer) V\liere grasping or a wrist part is equipped by the upper extremity 18 of 16, it 
becomes the instruction orbit 20 of upper extremity training movement, for example, a physical 
therapist's natural three- dimensional movement (the position P, speed (V) of X, Y, and Z) is 
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continuously acquired at a suitable interval (time or datum reference). This is explained in detail 
based on drawing 2 . 

[0021] First, each sign on the instruction orbit 20 shown in drawing 2 expresses the following 
contents. 

[0022] PI, P2, - - , Pn, - - Pm (the position of eye Pn:n watch, m: the number of acquired points) 
VI, V2, - - , Vn, - - Vm (speed in the position Pn of eye Vn:n watch) 
Tl, T2, - - , Tn, - - Tm (lapsed time in the position Pn of eye Tn:n watch) 

And the three- dimensional spline curve orbit which complements these smoothly based on the 
acquired position Pn is generated and saved. 

[0023] Under the present cucumstances, as the X- axis is set up as a key axis and it is shown in 
drawing 3 , the two- dimensional spline curve in each flat surface is calculated by projecting each 
point on a X- Y flat surface and a X- Z flat surface, for example, it calculates by computer, and a 
three- dimensional smooth curve orbit as shown in drawing 2 i s acquired by compounding these. 
And as shown in drawing 3 and drawing 4 , the section [Xo, Xmax] is suitably divided about the X- 
axis (J 1, J 2, - - , Ju, Ju+1, - - Jnmax), and curviluiear data is dispersed for an orbital operation. 
[0024] On the other hand, a patient or the user 16 performs movement training of the upper 
extremity 18, where it grasped or a wrist part is equipped with the tip part 14 in which posture 3 
flexibility of the robot arm 12 is free by the upper extremity 18 like the time of standard movement 
creation in training. Jo Sorama's virtual three- dimensional orbit 20 which loaded the standard 
movement data saved, for example in the memory (RA]V$ of the computer to the robot controller 
22 containing a microcomputer at this time, and was reproduced based on this so that the upper 
extremity 18 may move, Wien power is added to the upper extremity 18 via the robot arm 12 
driven with drives, such as a servo motor, the user 16 can feel as the space and a time restraint 
to standard movement, and can realize movement trainmg by three- dimensional Sorama of the 
upper extremity 18. 

[00251 Arrange the above-mentioned training robot's 10 utilization time, and the object based on 
the display 24 at movement evaluation of the gap from the instruction orbit 20, power, etc., a 
status display, or virtual train contents synchronizing with movement, and presence is shown, and 
it is possible to perform coordination operation of eyes and a hand etc. 

[0026] Under the present circumstances, although the flexible restraint to the instruction orbit and 
the movement direction of standard movement which were generated is given, that concrete 
method is as follows. 

[0027] namely, - - in drawing 4 and drawing 5 - - every control cycle of the training robot 10 - - the 
current position Qnow of the position (people's wrist position) of the tip part 14 of the robot arm 
12, and the control point Jn (n=0 - - .) on a three- dimensional orbit It searches for the point Ju 
these days [ with nmax ], and unit vector e of point Ju- >Ju+l direction is defined from these two 
Doints unit vector [ of the direction of cunent position Qnow- >Ju ] i, and these days on an orbit. 

0028] Here, unit vector i considers it as the return (restraint) power direction vector to an orbit, 
and unit vector e is taken as a movement direction vector. When search of the point Ju uses the 
oast searching history these days, a computer can search at high speed. 

0029] The orbital return (restraint) power Fi in drawing 5 is expressed with the function which 
several 1 defines. 
[0030] 

[Equation l]Fi=f (du, vn) - - here - - the distance between the duxurrent position Qnow- control 
points Ju, and the tip motion velocity of vn:robot arm - - specifically. For example, when it sets to 
Fi=Ki- du- Di- vn, it can restrain flexibly to the point on the orbit given with standard movement 
data with a spring with the virtual current position Qnow of the robot arm 12, and a damper 
element. 

[0031] By above- mentioned control, a patient or the user 16 can realize training of operation which 
met three- dimensional standard movement fundamentally by equipping a wrist etc. with the tip 
part 14 of the robot arm 12. Under the present circumstances, since flexible restricted control is 
performed, it can prevent adding a burden and load with a patient or the user 16 impossible for, 
and safe training operation can be performed. 

[0032] It is possible to adjust pliability with a dynamic change of Ki and Di parameter according to 
physical conditions and a movement situation. 

[0033] The grade individual difference which has also applied the same standard movement data as 
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another effect of flexible restricted control to the patient or the user 16 from whom the body 
characteristics, such as the length of an arm (upper extremity) and an angle of bend, differ, for 
example is absorbed, and smooth movement can be realized. It becomes possible to soften the 
shock at the time of continuation movement on an orbit, and smooth operation which met into 
orbit can be performed. 

[0034] Next, Fe which is the time binding force, traction, or load force of an orbital direction is 
calculated as follows. 

[00351 That is, since an orbital- direction vector is given by unit vector e explained previously, the 

size of this load force Fe can be expressed with several 2. 

[0036] 

[Equation 2]Fe=g (vr, vn, tr, tn) - - here, the binding force Fe of this orbital direction the target 
passage time in the control pomt Jn in the lapsed time tnstandard movement data from the target 
speed tnimovement start in the control point Jn in the tip motion velocity vnstandard movement 
data of vn:robot arm. It can express with several 3 as a concrete example. 
[0037] 

[Equation 3]Fe=helium, +Se, and (vr- vn- vh) - oe vn+ce - - here - - heliumitime restricted paragraph 
coefficient - - Se:speed restricted paragraph coefi'icient- D e:viscosity paragraph coefficient- C 
eifixed traction (fixed load force) 

a thitime restricted paragraph correction term vhrspeed restricted paragraph correction term - - 
safety being secured and by controlling a rapid speed change, by this, Feedback is applied so that 
time restraint based on standard movement data or speed feedback may be performed by 
performing parameter adjustment if needed and standard movement time may be followed. 
[0038] However, (tr- tn- th) and (vr- vn- vh) make th and vh the paragraph which can be adjusted 
dynamically in order to give pliability to a restraint so that a deviation may not become large above 
to some extent for safety. 

[0039] By adjusting above-mentioned Ce paragraph of several 3, applying the traction Fe according 
to the situation of rehabilitation training, and caiing for movement, or applying load force (traction 
of a negative direction), muscle training can be repeated and can be performed, for example. 
[0040] The block diagram explaining the composition of this training robot's 10 hardware is shown 

in drawing 6 . 

[0041] The training robot 10 in drawing 6 T he robot arm 12 as a robot body. The teaching data of 
standard movement is received from the external personal computer (henceforth a " computer" ) 
26, and the robot controller 22 which processes this data and drives the robot arm 12 is included. 
[0042] The pilot lamp 32 which displays the limit switch (not shown) which performs the 
potentiometer 30 and restriction of operation of detecting the servo motor 28 as a driving source 
and the actual active position of the robot arm 12, and an operating state on the robot arm 12 is 
formed. 

[0043] On the other hand, the robot controller 22, In order to deliver and receive immediate data 
between the central processing unit (CPU) 34, the communication interface (communication I/F) 
36 which connects this CPU34 and computer 26, the memory card 38 which saves various data, 
and CPU34 The connected memory card input output section (memory card I/O) 40 and the 
memory part 42 which is connected to CPU34 and saves data are included. It is connected to 
memory card 1/040, and preserved data is mutually delivered [ this memory part 42] and received 
between the memory cards 38 

[0044] The robot control program is memorized by the memory part 42 as preserved data. The 
memory card 38 is what saves personal data, such as movement data and individual training 
record, For example, read pei^onal data into CPU34 from the memory card 38 at the time of a 
training start, operation required for the robot arm 12 is made to perform, and it is used for the 
purpose of saving personal data after the end of training. 

[00451 furthermore - - between CPU34 and the servo motoi^ 28 - - D/A converter 44 and the drive 
circuit 46. Between the potentiometers 30, the interface (PIO) 50 is formed, respectively between 
the A/D converter, the limit switch which is not illustrated further, and the pilot lamp 32. 
[0046] Next, the operation in above-mentioned composition is explained. 
[0047]First, the teaching data of three- dimensional standard movement based on people's 
operation and action is loaded to CPU34 via communication I/F36 of the robot controller 22 from 
the computer 26. And in the robot controller 22, required preserved data is read from the memory 
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part (ROM and RAM are included) 42 and the memory card 38, and orbital creation, orbital 
calculation, or movement reproduction calculation is performed CPU34. The result is changed into 
an analog signal with D/ A converter 44, driving current is supplied to the servo motor 28 from the 
drive circuit 46, the robot arm 12 drives, and three- dimensional movement based on the teaching 
data of standard movement is shown to people. Thereby, training operation of the upper extremity 
18 of a patient or the trainer 16 can be performed, for example. 

[0048]In this case, the actual active position of the robot arm 12 is detected by the potentiometer 
30, and that analog signal is changed into a digital signal by A/D converter 48, and is inputted into 
CPU34 In CPU34, the servo motor 28 is controlled by calculating the gap (deviation) with the 
teaching data of standard movement, and giving a deviation signal to the drive circuit 46 via D/A 
converter 44, and the orbital return of the robot arm 12 is performed. The robot controller 22 is 
connectable with a network via the computer 26. 

[0049] The robot controller 22 performs one of the external pilot lamp 32, and OFF by PI050, or 
two or more one of the limit switch formed in the robot arm 12 and OFF are read simultaneously, 
and safety of operation is secured. And the instruction orbit 20 calculated from the robot 
controller 22 and the movement track based on operation of the robot arm 12 are displayed on the 
indicator (display) 24, and as explained previously, the trainer 16 can perform coordination 
operation of eyes and a hand. 

[0050] The guide control flow chart of the robot arm shown of operation is explained to drawing 7 
and drawing 8 . 

(1) Standard movement creation flow : in drawing 7 , the robot control program memorized by ROM 
of the memory part 42 of the robot controller 22 at Step SI is first set as a teaching mode of 
operation. 

[0051]Next, teaching data is generated at Step S3 by the therapist's instruction movement, 
operation by a user, reading of preserved data, or the other methods. In this working example, 
reading of the preserved data based on the computer 26 generates the three- dimensional 
movement teaching data of the body by people. 

[0052] At Step S5, three- dimensional movement teaching data is gained from the computer 26 to 
CPU34 of the robot controller 22 via communication I/F36, in Step S7, three- dimensional 
trajectory generation is perfoimed by CPU34, and a three- dimensional orbit is created. And in step 
S9, the data about the three- dimensional orbit created at the front step S7is saved at RAM of 
the memory part 42 Now, creation of a standard movement track is completed. 

(2) Movement reproduction flow : the upper extremity 18 of the user 16 who receives training 
assumes in this case that wearing or the tip part 14 is already grasped to the tip part 14 of the 
robot arm 12, for example. 

[0053] In drawing 8 , the robot control program saved at Step Sll at ROM of the memory part 42 of 
the robot controller 22 is set as reproduction mode of operation. And the teaching data of a 
three- dimensional standard movement track saved at RAM of the memory part 42 is read into 
CPU34. 

[0054]Next, in Step 13, the actual active position of the robot aim 12 is detected by the 
potentiometer 30, and the detecting signal is fed back to CPU34 as a digital signal via A/D 
converter 48. In Step S15, based on the fed- back detecting signal, the position and the amount of 
time lags from a standard movement track are calculated by CPU34, and the generated reaction of 
the robot arm 12 for an orbital return is calculated at Step S17 according to this amount of gaps. 
[00551And at Step S19, the driving current coiTesponding to the generated reaction calculated at 
Step S17 is supplied to the servo motor 28 from the drive circuit 46^ and it drives so that the 
orbital return of the robot arm 12 may be carried out. Under the present circumstances, it 
corrects to Step S13 so that change and adjustment of a virtual spring, a viscous parameter, etc. 
which does not carry out the position restraint of the user's 16 upper extremity 18 more nearly 
thoroughly than the robot arm 12 can perform a smooth orbital return. 
[0056] According to the flow shown in drawing 7 , the data about people's three- dimensional 
operation orbit may be acquired, and the flow shown in drawing 8 based on the data obtained here 
may be performed with other training robots. 

[0057] Next, other working example (the 2nd working example) of this invention shown in drawing 9 
is described. 

[0058] Extend the robot arm 12 shown in the 1st working example described previously in this 2nd 
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working example, and the attitude control of three axes is added, It is possible by adding 3 axis 
attitude control part 25 to the tip part 14 of the robot arm 12, and constituting the robot arm 12 
of six or more axes to perform movement presentation including a posture. Thereby for example, it 
becomes applicable to training of the pictures which need attitude control, calligraphy, etc. 
[0059]Furtheiinore it is based on this invention shown in drawing 10 , other working example (the 
3rd working example) is the training robot systems which station the training robot 10 of the 1st 
working example and the 2nd working example which explained previously, for example in a user's 
house, a training center, etc., and enabled it to use him for many people through a network. 
[0060] The robot 10 for training which explained the teaching data of standard movement 
previously from the host computer (external server), for example via the Internet 52 by using in a 
network as shown in drawing 10 (a) to two or more patients or users 16 who own Distribution, Or 
it is possible to transmit and receive mutually, to save on- line or this movement teaching data at 
the memory part 42 of the robot controller 22, and to perform movement reproduction off- line. 
[0061] As shown m drawing 10 (b), movement teaching data is distributed to two or more robots 10 
for training from a host computer (external server) in real time, 54, such as a lecturer, is able to 
perform training of calligraphy etc. through the networks 52, such as the Internet, simultaneously 
to two or more participants (user) 16, for example. 



[Translation done.] 
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DESCRIPTION OF DRAWNGS 



[Brief Description of the Drawings] 

[Drawing 1 lit is a perspective view explaining the outline composition of the training robot which 
shows the 1st working example by this invention. 

[Drawing 2] I t is a perspective view of the three- dimensional orbit data used by this invention. 
[Drawing 3] It is an orbital exploded view in the X- Y flat surface in drawing 2 , and a X- Z flat 
surface. 

{Drawin^J^ft is a key map for performing calculation of the orbital return (restraint) power in 

dra w ing 2, and orbital- direction binding force. 

[Drawing 51 They are other key maps equivalent to drawing 4. 

IDrawing 6|It is a block diagram showing the composition of the hardware of training ROBOTTOA 
by this invention. 

[ Drawin g 7] It is a control flow chart which shows operation of the standard movement creation by 
a robot arm. 

[Drawing 8] It is a control flow chart which shows operation of the movement reproduction by a 
robot arm. 

{Drawing 9| It is a slant- face figure showing the outline composition of the training robot containing 
the attitude control part which are other working example of this invention. 

{Drawnj> 101(^ And (b) is an explanatory view of the training robot system with which all used the 
network which is working example of further others of this invention. 
[Description of Notations] 
10 - - Training robot 
12 - - Robot arm 

14 - - Tip part of a robot arm 

15 - - Grasping and applied part 

16 - - User (a patient or a trainer also contains) 
18 - - Upper extremity 

20 - - Instruction movement track 

22-- Robot control part (robot controller) 

24 - - Indicator (display) 

25 - Attitude control part 

26 - - Computer 

52-- Internet (means of communication) 
[Translation done.] 
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